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THE ROBOTIC WORKCELL 


INTRODUCTION 


A robot is almost never used as a stand alone device. 
A robot is almost never used without other automated equipment. 


Robots work in workcells. The workcell is the environment within which 
robots work. Within this environment they serve and are in turn served by 
other automatic and/or computer controlled equipment. In the workcell, the 
robot usually takes the place of the human being. As such, the robot usually 
serves the needs of the machines in the cell. That is also what the human 
operator does most of the time... serve the machinery that he or she is 
operating. 


In order to be able to serve the machinery well, the operator is made 
familiar with the operations to be performed and knows when to feed or 
empty a machine. The familiarity that he has, is gained through years of 
experience and formal training. Now we want a robot to take over this 


tedious, repetative work. What do we have to do, to enable the robot, to do 
this? 


Basic Requirements: There are a number of basic requirements that have 
to be fulfilled. Among them the following are the most important. 


1. The robot selected has to be able to manipulate the parts and 
materials being used in a manner that will be similar to what 
the human operator does for this particular application. This is 
a function of the design of the robot. 


2. The robot has to have an instruction set that allows us to 
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program it to do the work that we want done. The instruction 
set is the language of the robot. The instruction determines 
what we can tell the robot to do. 


3. The robot has to have a way of being told when to start and Stop 
doing the work that needs to be done. This controlled by the 
input and output capabilities of the robot. 


4. The machines that the robot works with have to be able to tell 
the robot when to start or stop doing the work that needs to be 
done. They have their own input/output that allows them to do 
this. 


S. The robot has to be able to tell the machines what it is working 
with and when to start or stop doing the work that needs to be 
done. This too is handled through the input/output. 


6. Detectors have to provided to serve as the ears, hands and eyes 
of the robot. These detectors are tied into the I/O to tell the 
robot what is occuring. 


As stated above, all this communication between the machinery is handled 
with what we call I/O (Input/Output). Each machine has a number of inputs 
that it can respond to and each machine has a number of Outputs that it can 
manipulate. The output from one machine is usually the input into another ° 
machine and vice-versa. So the signal is either an input or an output 
depending whether it is going into the machine or coming out of the machine. 
The inputs and outputs can be ON-OFF devices or they can be variable 
signals. The less expensive machines would tend to use ON-OFF Signals. 


Programmable Controllers: Often the workcell is so complicated, that 
the I/O is handled by special computers that are designed specifically for 


handling I/O. These specialized computers are called Programmable 
(Logic) Controllers. On the factory floor they are referred to as PLCs or 
PCs. This is distinct from the use of the term PC to describe a personal 
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computer. In this discussion we will restrict the meaning of PLC to 
Programmable Logic Controller. 


It is necessary to have all the I/O handled by a PLC because the computers 
that are controlling the robot are too busy with the many real time tasks 
required by the robot itself. The same is true of other automated equipment 
like CNC (Computer Numerically Controlled) machines like lathes and milling 
machines. The I/O interaction required by these machines is usually limited 
to telling the machine when to start and when to stop on the input side and 
to telling the PLC when the work in progress is completed so that the next 
operation can be initiated on the automatic machine side. Usually the PLC 
handles everything else. 


The Typical Workcell: So, the typical robotic workcell consists of a 

robot, a PLC, maybe a CNC lathe, a CNC milling machine, a conveyor bringing 
work to the workcell and one going from the workcell to the next station. A 
sophisticated system might have vision support for the robot and may have 
an automated inspection station to confirm that the work was actually done 
as 


CNC Lathe 


CNC Vertical 


Milling Machine Computerized 
inspection 


Figure 1 
A Typical Flexible Manufacturing Cell 


specified. Such an arrangement might also be called a flexible 
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manufacturing or machining cell (FMC). For our purposes it is a workcell for 
the robot. A cell of the type described above would be able to perform the 
necessary machining operation for most manufactured items requiring lathe 
and milling machine work. Other cells might concentrate on assembly or 
welding and painting operations as their main focus. 


In the case of the Rhino XR robot and it's Mark II! coniroller, the user has 
two options for working with and handling the I/O. The controller has the 
ability to respond to sixteen input lines (8 are for the user, 8 are 
microswitches, one on each motor ports) and can control 8 output lines. 
These lines can either be connected directly to the control functions desired 
or they can be routed toa PLC. Rhino's RoboTalk™ Language supports 
complete |/O capability and can be used to control all aspects of the Mark III 
Controller. 


Vertical 
Conveyor Ball sorter Fel 
Fei ERS Ee RES 
Computer , CRT 
and Controller Carousel 
cag 


Station 


Belt Conveyor 


Keyboard 


Figure 2 
The basic layout of the Workcell. 


The Workcell: The workcell is designed to introduce students and trainees 
to the basic techniques used in the design and use of workcells and robots. 
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The basic layout of the workcell is as shown above. 


WHAT THE WORKCELL DOES. 


The Rhino Workcell is designed to perform a sophisticated palletizing and 
order checking operation. The operator orders a pallet with either one or 
two ping-pong balls on it. The workcell system has both light and dark 
ping-pong balls in it. The operator specifies the coloring of the balls to be 
palletized. He can ask for light or dark units or he can ask for one of each. 
He or she also specifies whether the cell is to cycle once or to run 
continuously. 


The information is entered at an order center. 


The robotic system reads the information entered and then looks to see if 
the conveyor has delivered a pallet to the pick up point. If there is no pallet 
at the pick up point, the controller starts the conveyor and runs it till a 
pallet arrives at the pick up point. The robot picks up the pallet and places 
iton the rotary table, on the pins for the pallet. If the pallet does not 


setile down on the pins, an error message signal appears on the CRT of the 
computer. 


Next the robot determines if the first ball that it needs is available at the 
ball sorter. If the right ball is not available, the controller starts the 
vertical conveyor until a ball of the right shade arrives at the pick up point. 
It then shuts off the vertical conveyor. 


The robot picks up the required ping-pong balls and places them on the 
pallet. 


After the robot moves out of the way, the rotary table is rotated to bring 
the pallet under the inspection station. The controller then inspects the 
pallet to make sure that a ball(s) is present and that each one is of the 
shade that was originally specified at the order center. 
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lf the order is right, the green “order O.K." light is turned on. If the order is 
wrong, the red "order not O.K." light is turned on and the system makes the 
necessary moves to correct the situation automatically. All conditions 
encountered are annunciated at the computer CRT. 


Aiter a correct order has been assembled, the robot unloads the pallet and 
puts all items back in their respective feeders, ready for the next order. 


The workcell demonstrates the operation of an intelligent workcell. The 
workcell can be programmed in a number of different ways, in a higher level 
language, by students and trainees who are are learning about robotics and 
robotic languages. 


Besides allowing programming in a higher level language, the workcell 
trains the students in the field of robotics and automation to think in terms 
of the special requirements of machines that interact with one another. 
Though a well designed and implemented task looks trivial to the 
un-initiated observer, the requirements are quite complicated. Notice that 
there are a very large number of detectors on the workcell. Each one gives 
the system a specific piece of information about what is going on in the 
cell. The computer uses this information to make decisions about the task 
being executed. | 


The components of the workcell may be arranged in other ways to create 
other workcell configurations. Advanced students can modify the existing 
workcell as may be required to add other capabilities to the system. Other 
accessories needing either encoded or unencoded motors can be made by the 
Students as might be needed to effect the manipulations that the cell 
requires. 


UNPACKING THE WORKCELL 


The workcell consists of an integration of standard Rhino XR accessories 
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with the other items needed to create the workcell. The unit is shioped as 
the following major systems: 


The XR robot. 

The Mark III controller. 

Linear slide base 

Rotary carousel and inspection station. 

Belt conveyor with I/O modules and pallet return. 
Vertical conveyor with ball return and sorter. 
Package containing miscellaneous items. 

Base for top surface. 

Top surface that all parts are mounted on. 


OMONDAARWh > 


Each standard Rhino XR Accessory has its own manual and that manual 
should be consulted for information about that particular accessory. These 
manuals come with the workcell. The main Workcell Manual contains 
information about putting the various parts together to create the workcell. 
(The vertical conveyor does not have a separate manual. It is considered a 
part of the work cell.) 


The following general assembly sequence will be followed. 

1. Unpack all items and place them on a work surface. 

2. Place the base where you want to locate your workcell. Note 
that the workcell will require 115 VAC power. Position the unit 
near a power outlet. (A total of three items need to be plugged 
in; the computer, the Mark II] Controller and the ball sorter.) 


3. Place the table top on the workcell base. 


4. Mount the workcell items on the workcell surface and secure 
each item in the following order: 


A. Horizontal belt conveyor and pallet return 
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B. Linear slide base 

C. Order center 

D. Rotary carousel and inspection station 

E. Vertical conveyor, ball sorter and ball return 

F. The robot and Mark III Controller with Teach Pendant and I/O 

G The host computer. The IBM-PC and Apple lle are supported by 
Rhino but other computers may be used also. 

H. Wiring. 


9. Go through the test procedure for each item. 
6. Wire the items together as shown in the manual. 


TOOLS NEEDED 
You will need the following tools to put your workcell together: 


1. A large screwdriver for the screws that hold down the various parts 
of the workcell to the table top. 


2. A small screwdriver to wire to the connectors at the various points. 
This has to be a fairly small unit if it is going to fit in the screw 
holes on the connectors of the PC boards. 


3. A Rhino tool kit consisting of a set of Allen wrenches for the socket 
head screws. 


4. A 1/4" electric drill and drill bits for making holes in the top of the 
work surface if modifications are to be made. 


S. A-set of combination wrenches from 1/4" to 5/8" for various nuts 
and bolts that might need to be tightened. 


6. A high impedence volt meter to measure voltages at the detectors 
and for calibration and testing. 
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Figure 3 
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Figure 5 THE RHINO WORKCELL WIRE ROUTING DIAGRAM 
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THE HORIZONTAL CONVEYOR 
PURPOSE 


In the workcell, the horizontal conveyor acts a device for feeding the empty 
pallets to the robot whenever they are needed. The pallets are fed from one 
end of the conveyor. A pallet return ramp is used to return the used pallets 
to the other end of the conveyor. An optical detector provides the signal to 
indicate that a pallet is ready to be picked up. Static devices that orient 

the pallets are placed along the top of the conveyor. 


CONTROL 


The conveyor motor is controlled as an on/off device by the controller from 
Aux 2. The controller can read the presence of a pallet at the down stream 
end of the conveyor by reading the optical I/O module. (Input #6) 


MOUNTING THE HORIZONTAL (BELT) CONVEYOR 
AND PALLET RETURN RAMP 


Attach the pallet stop plate to the end of the horizontal conveyor away from 
the motor with two 6-32 x 1/4 BHCS. Be sure the slotted end is as close to 
the belt as possible without touching it. Refer to figure 7. Also attach the 
S pallet orienters using ten 8-32X1/2 SHCS. Refer again to figure 7 and 
make sure the orientation of the pallet orienters matches that of the 
diagram. The numbers next to the pallet orienters in the diagram refer to 
the number of holes along the top edge of the side plates with the first hole 
being nearest the pallet stop plate. 


Fasten the 4 mounting brackets to the table top of the workcell and position 
the conveyor over the brackets. Refer to the Rhino Workcell diagram for 
positioning the conveyor. Attach the conveyor to the brackets using a 
washer and a 10-32X1/2 SHCS. Refer to figure 8. You may wish to first lay 
the motor cable down under the conveyor such that the motor cable end 
comes out from under the end of the conveyor with the pallet stop plate. 
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Referring to figure 7, attach the 2 sensor modules to the conveyor. Make 
sure the IR-LED and phototransistor (covered in heat shrink tubing) are 
peeking through the holes in the side plate. Be sure the modules are 
mounted such that the optic sensors are nearest the top of the conveyor and 
that the red LED is nearest the bottom. 


Pallet stop Return base 

plate | 
6-39 Ba a =e oo, 
KX 1/4 ea eee , @-———— Wood Screw *12 
BHCS ge —~ Bracket x7/8 pan 


i ee e se 
awash r¥10 


re 14 
gets | i el Bolt 10-32x1/2 
| 4 Number of holes SACS 
a. from stop plate end 
[ 1/2" Spacer or 2 1/4" spacers 
10-32X3/4 SHCS 


Heat shrink tubing over IRLED and phototransistor 
inserted into conveyor side plate 


Figure 6 
Horizontal conveyor, pallet sorter, pallet stop plate 
and sensor module mounting. 
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10-32x1/2 SHCS 
Outside 


Side Plate » O-washer 


F 128776 


Wood screw ie 


Figure 7 
Horizontal Conveyor mounting bracket assembly. 


The Pallet Return Ramp comes completely assembled. Remove the 4 screws 
holding the long ramp (2 at one end, 2 underneath the ramp at the end 
nearest the short ramp) and set the ramp aside. Remove the 5 screws 
holding the short ramp and set the ramp aside. Mount the base of the return 
ramp onto the workcell base with 4 wood screws or bolts refering to the 
Rhino Workcell diagram for positioning. Replace the long and short ramps. 
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Figure 8 
Horizontal conveyor connections 


For AUX 2, the switch controls the direction of motion of the 
horizontal conveyor, normally the switch is in the down 
position. 


Note: Toggling the AUX switches when the aux ports are ON is 
not recommneded. This can cause a voltage spike to enter 
the controller circuitry and cause loss of communication 
with the host computer. If this happens, you will have to 
reset the entire system and start over. 
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THE LINEAR SLIDE BASE 
PURPOSE 


The linear slide base serves to extend the reach of the robot by providing 
lateral movement at the base. This allows the robot to serve a larger 
workcell. 


CONTROL 


The linear slide base is controlled as an accessory with an optically encoded 
motor. It is controlled from port "G". Using the optically encoded motor to 
run the linear slide base enables fine positional control of the robot. 


MOUNTING THE LINEAR SLIDE BASE 


The platform on the Linear Slide Base must have a spike mounted at the 
corner hole that will be closest to the Horizontal (Belt) Conveyor. Refer to 
figures 10 and 12. The spike must be mounted before attempting to mount 
the slide base itself. The spike is used to aid in homing the robot system. 
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- \/4-20 Hex nut 
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= 


Slide Base Platform 


Spike 


Figure 10 
Linear Slide Base homing spike assembly. 


The Linear Slide Base is mounted to the workcell base using 4 sets of 
brackets. See figure 12. Refer to the Rhino Workcell diagram for 
positioning the slide base. Note in figure 11 that all brackets are mounted 
on the end plates such that they are "inside" the slide base. Note also that 
the brackets used to mount the slide base are different from the brackets 
used to mount the Horizontal (Belt) Conveyor and should not be intermixed. 
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. 1/4-20x3/4 
Outside SHCS 
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screw 


Figure 11 
Linear Slide Base mounting bracket assembly. 
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Figure 12. 
Linear Slide Base mounting diagram. 
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TESTING THE SLIDE BASE: 


Plug the Linear Slide Base's motor cable into port "G" of the Mark III 
Controller. Make sure the mode switch is in the up (Teach Pendant) position. 
Use the teach pendant's "G" motor move key to move the slide base platform 
back and forth. If the motor runs away, the most likely cause is the motor 
encoder optics. A quick check to test this possibility is to plug the motor 
cable into a different port (but not the "A" port) and use the pendant again. 

If the motor operates correctly, then the controller is at fault and you 

should contact Rhino Customer Service. If the motor still rungs away while a 
known good motor works well in the same port, the problem is most 
probably in the motor's encoder optics. 
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THE ORDER CENTER 
PURPOSE 


The order center serves as the interface between the operator and the 
workcell. This is where the operator tells the workcell what needs to be 
done. In an automated system, this might be the point where the control 
computer or programmable controller interacts with the workcell. 


CONTROL 
The operator has the following control options: 


1. Order one dark ball 

2. Order one light ball 

3. Order one light ball and one dark ball 
4. Order two light balls 

5. Order two dark balls 


6. Request one cycle 
7. Request continuous operation 


8. End program. 
MOUNTING THE ORDER CENTER: 


The Order Center is shipped with the top case already fastened to the 
bottom case by 4 screws. Remove the 4 screws and set the top aside. Take 
the bottom case and mount to the workcell base with 2 wood screws. Refer 
to The Rhino Workcell diagram for placement. Re-attach the top to the 
bottom case with the 4 original screws. Refer to the Order Center 
Connection diagram (figure 13) and connect the Order Center to a Mark III 
Controller being sure that all power is off. 
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Figure 14 
The order center. 


PRETESTING THE ORDER CENTER: 


Turn the Mark III Controller on. The red "ON" lamp on the Order Center should 
be lit. If it doesn't, turn off all power and recheck all connections. Press 

each yellow button in succession. The yellow LED next to the pressed 

switch should light up with any other previously lit yellow LED turning off. 
Press the single cycle button. The green LED next to it should turn on (it 

will only turn off under program control or by removing power). Press the 

run button. The green LED next to it should be lit. Pressing the stop button 
should turn the LED off. If any of these procedures do not produce the 
desired results then the Order Center is faulty and you should contact 
Customer Service. 


ORDER CENTER TEST PROGRAM: 


With a host computer attached to the Mark III Controller, boot up RoboTalk™ 
and run the program called "TSTORDER". The monitor screen should first 
clear then display the current status of the Order Center. No order will be 
recognized until the run or single cycle buttons are pressed. If you press 

the run button you can press any yellow button and the screen should show 
the corresponding selection. Pressing the stop button will cause the screen 
to show no selection. If you press the single cycle button the screen will 
briefly flash the order that was selected and then display no selection. At 
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the same time the green LED next to the single cycle button should turn on 
then off. (You may find it necessary to briefly hold down the single cycle 
button to give the computer time to recognize it. However, holding it down 
too long may result in multiple single cycles.) If the screen does not 
display the expected results, shut down all systems and recheck all 
connections. If you still encounter problems, contact Customer Service. 
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ROTARY CAROUSEL and INSPECTION STATION 
PURPOSE 


The rotary carousel provides a means of transfering a pallet, that has been 
filled with an order, to an inspection station. 


CONTROL 


The carousel is controlled through port "H" as an "encoded motor" driven 


accessory. This allows the carousel to be positioned accurately at either end 
of its 180° travel. 


The controller can read the status of the four detector lines at the 
inspection station to determine the status of the order. Four outputs are 
used to test the conditions at the inspection station (two lines for shade of 
each ball and two lines for presence). If the condition matches the output, 
input 5 of the controller will be taken low. 


SETTING UP THE ROTARY CAROUSEL 
and the INSPECTION STATION: 


Remove the 3 screws that fasten the platter to the carousel. Removing the 
platter makes it easier to mount the unit to the table top. 


Mount the base of the carousel to the workcell base with either 2 wood 
screws. Refer to the Rhino Workcell diagram for the relative placement of 
components. 
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Figure 15 
The Carousel and inspection station. 


Remove the 4 screws holding the base plate to the bottom of the inspection 
station and set it aside. Mount the base to the workcell table top with 2 
wood screws right behind the carousel again refering to the Rhino Workcell 
diagram. Re-attach the inspection station to its base. 


Position the vertical axis of the carousel so that the home position 
microswitch is centered on the actuating cam. Replace the carousel's platter 
making sure the pins with the 2 switches on either side are positioned 
towards the Linear Slide Base and the other 2 pins are as close to the center 
of the Inspection Station as possible. You may have to loosen one of the 
clamps on the vertical axis shaft to allow proper orientation of the platter. 
Retighten the clamp. Be careful with the wires underneath the platter and 
make sure they are on the side closest to the Ball Feed Ramps. 


Refer to the inspection station ("A" Side) Connection diagram and connect the 
inspection station to the Mark III Controller being sure all power is off. 


Refer also to the inspection station ("B" Side) Connection diagram and ensure 
all connections are as they should be. (This section is shipped prewired. ) 
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Figure!6 INSPECTION STATION ("A" Side) CONNECTION 
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Figure 17 INSPECTION STATION ("B" Side) CONNECTION 
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PRETESTING THE INSPECTION STATION: 


With all power off, disconnect the wires leading to the Mark II] Controller's 
outputs 7 and 8 and reconnect them to output 10 (Ground). 


Turn the controller on. Both the Accept and Reject lamps on the Inspection 
Station should be lit. If either or both do not turn on, turn power off and 
recheck all connections. 


lf all else appears to be all right, the inspection station may be faulty and 
you should contact Customer Service. 


Make sure all power is off and reconnect the wires to outputs 7 and 8. 


Place a pallet onto the two pins of the platter underneath the Inspection 
Station. 


A voltmeter is required to measure the voltage on the pins on the inspection 
Station ("B" Side) Connector. 


Turn power on again. 


With the voltmeter grounded to pin 2, pins 9 and 10 should give a voltage 
reading of between 3.5 and 5.0 volts. 


Pins 7 and 8 should give a voltage reading of between 0 and 0.8 volts. If pin 
9 shows a low voltage then Receiver "H" needs adjustment. If pin 10 shows a 
low voltage then Receiver "F" needs adjustment. If pin 7 shows a voltage too 
high then Level Detector "J" needs adjustment. If pin 8 shows a voltage too 
high then Level Detector "I" needs adjustment. 


Refer to the Optic Modules description for the adjustment or calibration 
procedures. 
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Place a ball of any color onto both sides of the pallet. Pins 9 and 10 should 
now show a voltage of 3.5 to 5.0 volts. With a dark ball on the right side of 
the pallet as seen from the robot, pin 7 should show a voltage of between 0 
and 0.8 volts. A light ball should show a voltage of between 3.5 and 5.0 
volts. Similary, a dark ball on the left side of the pallet should produce a 
voltage of 0 to 0.8 volts on pin 8 while a light ball should produce 3.5 to 5.0 
volts. 


Again, if your measured voltages differ from what is expected, refer to the 
Optic Modules description for calibration procedures. Be sure that the ping 
pong balls are well centered under the modules when making these readings. 
The color checker is more critical than the presence detector. 


TESTING THE INSPECTION STATION: 


Place a second pallet onto the pins of the platter of the carousel closest to 
the robot. Be sure the pallet is seated flat (both switches must close or the 
test will fail). 


With a host computer attached to the Mark III Controller, boot up RoboTalk™ 
and run the program called "TSTINSPECT" ("tstinspe" on the IBM). 


The monitor screen should first clear then display the current status of the 
inspection station. 


As you place different combinations of light and dark or no balls on the 
pallet underneath the inspection station the screen should clear and display 
the current contents of the pallet. 


If the screen continues to display an inspection station error then recheck 
the wire leading from pin 5 of the inspection station ("A" Side) through the 2 
switches underneath the platter and terminating at input 5 of the controller. 


Also check all wiring between the controller and the inspection station ("A" 
Side). If the same message still appears, remove the pallet closest to the 
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robot and manually press both switches down. If the message goes away, one 
or both switches need to be raised slightly. If the error message still 

persists, either the pretest procedure should be repeated or the inspection 
station may be faulty and you should contact Customer Service for service. 


You should note that although a light ball appears light to the human eye, the 
optics module may sometimes recognize it as dark. The reverse is true fora 
dark ball. This usually happens due to reflections or surface irregularities 
and such a ball should be replaced or repainted. 
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THE VERTICAL CONVEYOR AND BALL SORTER 
PURPOSE 


The vertical conveyor and ball sorter provide a means of warehousing balls 
of two colors and then sorting the balls and providing the sorted balls at 
two fixed locations. This emulates a parts sorting and feeding system. The 
robot picks up the parts from known locations and puts back the parts ata 
known location. 


CONTROL 


The sorting of the balls is automatic. Whenever a ball appears in the sorter, 
it is either allowed to pass along the trough or dropped down to the lower 
trough depending on its color. 


The vertical conveyor motor is Controlled as an ON-OFF motor from port AUX 
1 of the Mark III controller. | 


The controller can determine the presence of the second ball on each of 
the troughs. 


MOUNTING THE VERTICAL CONVEYOR 
AND THE BALL SORTER 


The vertical conveyor/sorter system is shipped as four separate parts 
assemblies that have to be assembled by the user. They are: 


1. The conveyor itself 

2. The sorting assembly and upper and lower troughs 
3. The power supply and support column assembly 

4. The ball return trough. 


All the parts needed to assemble the unit into a working module are 
provided with the workcell. 
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The individual parts are prewired, and only the the wiring between them 
needs to be connected. The wiring from the optical module detectors to the 
Mark Ill Controller is discussed separately in other section of this manual. 


Start by placing the vertical conveyor and ball chute in front of you on one 
side and the power column assembly on the other side. These two form the 
supports for the ball sorter and the ball return. 


First mount the ball return to both the vertical elements. Do not tighten the 
screws at this time, you may need to make adjustments as you go along. 
This will space the vertical supports at the right distance from one another 
and will make it easier to install the ball sorter mechanism. 


Next install the ball sorter mechanism parallel to the ball return on the two 
supports. Again do not tighten the screws just yet. 


Next wire the power supply module to the sorter solenoids as indicated in 
the diagrams. This will make the sorting system complete. 


Wire the detectors for the light and dark balls, at the end of the ball 

troughs, to the Mark III controller as shown in the diagrams. This completes 
the wiring of the vertical conveyor/sorter system. 

After everything is together, tighten all screws. 


Mount the unit on the worcell top with wood screws as shown. 
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Figure 18 
Vertical conveyor, ball ramps, sorter 
and return ramp mounting. 
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Vertical conveyor connections. 
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THE OPTIC MODULES 
PURPOSE 


The optic modules provide information to the controller on the presence and 
color of the ping pong balls in the system. The color testing is done with 
reflected light. The presence is detected by obstruction of an IR beam. 


CONTROL 


The controller can read the two types of detectors to determine wether the 
ball is present or not and if present whether the ball is dark or light. A ball 
that is not present is seen as a dark ball. The experimenter should 
determine that a ball is present before trying to determine its color. 


THE OPTIC MODULES (detectors) 


There are three types of optic modules, the Receiver, the Transmitter and 
the (Reflectance) Level Detector which is a combination of a Transmitter 
and a Receiver built into the same shell. The Receiver and Transmitter work 
together as a pair positioned across the object to be detected. 


Transmitter: Referring to figure 21, the Transmitter has a two pin 
connecior on top and an infra-red LED mounted inside such that it emits 
light through the middle hole on the bottom. (Note that the hole is 
off-center.) No adjustments are necessary, advisable or possible on the 
Transmitter modules. 


Receiver: The Receiver has a three pin connector on top and a 
photo-transistor mounted inside it such that it receives light through the 

same middle hole on the bottom as the Transmitter. By mounting the 
Transmitter and Receiver such that they oppose each other, objects can be 
detected between them by the presence or absence of a signal at pin 3 on the 
Receiver (see figure 21). Shading the sensor is not necessary as the optic 
module housing itself provides for it. It may be necessary to adjust the 
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trim pot located behind a hole in the side of the optic module. A small 
screwdriver is required. With no object between the modules a voltage of 
3.5 to 5.0 volts should be read at the signal pin (pin 1) of the Receiver, With 
an object blocking the light from the Transmitter, a voltage of 0.0 to 0.8 
volts should be read at the signal pin of the Receiver. 


To calibrate the Receiver, mount the Transmitter and Receiver as shown in 
figure 21 with no obstacles between them. With a voltage meter at the 
signal pin of the Receiver, adjust the trim pot with the screwdriver until a 
high voltage is obtained then back off until the voltage drops to a low then 
turn the trim pot in the other direction again until the high voltage just 
returns. If you change the distance between the modules you may find it 
necessary to readjust the Receiver sensitivity. 


Level Detector: The Level Detector is essentially a Transmitter and 
Receiver pair built into one module. However the infra-red LED and 
phototransistor are mounted at an angle (see figure 22). This allows you to 
detect the difference between light and dark objects based on their 
reflective properties of infra-red light. The infra-red LED is mounted in the 
left hole in the bottom of the module (near the middle) and the 
phototransistor is mounted in the hole nearest the end of the module. 


Like the Receiver, a trim pot is located inside the hole on the side of the 
module and may require adjustment. In this case, with no object or a very 
dark object the voltage at the signal pin (pin 1) should be 0.0 to 0.8 volts. 
With a light or highly reflective object a voltage of 3.5 to 5.0 volts should | 
be read. The adjustment procedure is the same as for the Receiver but with 
a light or highly reflective object in place. 
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TEACHING THE POINT LOCATIONS 
NEED TO REDEFINE POINT LOCATIONS 


The programs provided with the workcell use named locations as points that 
the robot moves to. These were defined at the factory for the particular 
workcell that the software was developed on. Your workcell will be slightly 
different from the one at the factory because your components will be 
mounted slightly differently on your workcell. For this reason it is 

necessary for you to redefine the points in the workcell as the points that 
are specific for your particular workcell. The locations of the points are 
defined in the attached figures. 


TEACHING THE XR-2 WORKCELL 
LOCATION POINTS UNDER RoboTalk™ 


In a workcell environment, a robot may be required to approach an object, 
grip it and retreat while avoiding obstacles that are many times very close 
to the object of interest. A programmer/user must be very careful in 
manipulating the robot around these obstacles to avoid damaging either the 
obstacle or the robot arm/gripper itself. Usually, in teaching the arm, 
whether it be by lead-through or teach pendant, avoiding the obstacles is 
relatively easy. The problem arises when the program is run. In 
point-to-point robot systems, be they straight-line path or not, the robot 

will not follow the exact path that was taken when the robot was taught. It 
is only the points in space themselves that were taught and not the path and 
so the arm doesn't really care how it gets to the point. Figure 23 illustrates 
a typical problem. The left illustration shows the path that was taken in 
teaching the robot. Although the motors may start at the same time, 
because one axis may have farther to travel than another, the axis do not 
stop at the same time and the path shown by the right illustration of figure 
23 is taken resulting in a collision. 
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Figure 24 
Relative robot arm paths. 


Normally this problem is only of interest when picking up or putting down an 
object. The easiest way around the problem is to limit the number of axes 
that would be running when approaching or retreating from critical points. 
Figures 24 and 25 illustrate this. In both cases, only the the D motor joint 
is being operated between points P1 and P2. In this way the 
programmer/user can see exactly the path the robot will take and therefore 
not fear a mishap when the robot executes the taught program. In general, 
when using Robotalk, the procedure to follow is: 


1. Move the robot such that the gripper is in position to grip or 
release the object of interest. (P1). 


2. Move a single axis (usually the D axis works best) such that the 
gripper moves away from the previously taught point. (P2). This 
point is then the point the robot will move to prior to moving to 
P1 and is also the point the robot will move to when moving away 
from P1. 


For example, assume that a square block is at location P1 and we are 
interested in picking it up to transfer it to some other place. 


1. Using the pendant (after entering 'T P1' in edit mode), move the 
robot to P1 with the gripper open and ENTER that as a point. Then 
enter ‘T P2' and move the D axis to bring the gripper to P2 and 
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ENTER that as a point. Finally, enter 'T P3', close the gripper and 
ENTER that as a point. Note that P3 and P2 are the same points in 
Space with the difference being the gripper is open at P2 and 
closed at P3. 


The executable program would then look like this: 


movep P2_ ;gripper open, ready to approach the object 

movep P1_ ;gripper open, ready to grasp the object 

close -1 ;grasp the object, ready to move away from the object 
movep P3_ ;gripper closed, ready to move to some other place 


2. It should be noted that since P3 was taught with the gripper 
closed, and, since the gripper is always operated first before any 
other axis is operated, the command ‘close -1' is redundant and 
can be left out. 


Figure 25 
Effect of moving the elbow joint only. 


Page 47 Workcell User's Manual 
Copyright: Rhino Robots Inc., 308 South State St., Champaign, IL 61820 USA 


The Rhino Workcell Page 48 


Figure 26 
Effect of moving the Elbow joint only. 
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RHINO WORKCELL STARTUP PROCEDURE 


Once the workcell has been assembled and tested, the system is ready to be 
used. The following startup procedure is recommended. 


1. Make sure all power switches are off. 

2. Make sure the host computer (Apple lle, IBM PC) is plugged in. 
3. Make sure the Mark III Controller is plugged in. 

4. Make sure the Ball Sorter Mechanism Is plugged in. 


So. Turnon the Ball Sorter Mechanism. Throw a ball or two into the 
sorter and make sure the Ball Sorter works. (If a ball bucket is in 
the way, you can move it away by turning the shaft on the vertical 
conveyor motor with your hand.) 


6. Be sure the mode switch on the Mark III Controller, is in the "UP" 
or teach pendant position. 


7. Turnon the Mark III Controller. The XR-2 gripper should close 
then open. If it doesn't, press RESET. 


8. If you have an IBM-PC as the host, skip to step 10. There are two 
sets of black pins on the platter of the rotary carousel. One set 
has a small switch on either side. This set of pins is supposed to 
be nearest the robot arm. The other set should be centered under 
the inspection station. The best way to do this is to place a 
pallet on the pins under the inspection station and center the 
carousel using the teach pendant's "H" motor keys. 


NOTE: Be sure not to turn the carousel in a direction that will cause 
the wire under the carousel's platter to wind around itself. 
Accuracy is not critical but if you wish you can use tape ora 
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mark on the platter and inspection station to aid in centering. 
Y. Using the pendant's "G" motor keys, center the spike that's on the 
base of the robot on the mark on the yellow tag located on the 
work base under the front of the linear slide base. 


10. Using the pendant, execute a "Hard Home" 


11. After the hard home has been executed, turn on the host computer 
and boot up RoboTalk™. 


12. Answer "yes" when queried about initializing the robot. 


13. If you have an IBM-PC as your host computer, load the "HOMEGH" 
program and execute it. This will home the linear slide base and 
the rotary carousel. 


14. Load "WORKI" if the host is an IBM-PC. Load "WORKA(" if the host 
is an Apple lle. 


15. Enter the direct exectution mode and do a HARDHOME. Then return 
to the main RoboTalk Menu. 


16. You are now ready to either run a workcell program provided by 
Rhino or to create and run your own programs. 


The workcell can also be programmed in the other robotic language 
emulations provided by Rhino. 
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USING THE WORK CELL. 
The work cell may be used in the following modes: 


--> As ademonstration work cell used primarily as a demonstration 
device to familiarize potential users with the type of functions that a 
robotic work cell can be expected to perform. 


--> Asa training tool to train personnel in the use of robotic languages. 
Learning to use the language is facilitated when there is a specific 
task at hand. The students learn by programming the robot to execute 
the functions needed to make the work cell do its work. 


--> Asa training tool for use in learning about the hardware needs of 
robotic cells as related to the capability of each device in the work 
cell and the need of input and output lines to allow the entire system 
to be tied together. 


--> The work cell may also be reconfigured to show the students that 
there are many ways to set up a work cell for any single task. 


CONTROLLING THE WORK CELL. 
THE COMMANDS THAT YOUR WORK CELL OBEYS. 


It is easiest to control the work cell from a higher level language such as 
RoboTalk™. The RoboTalk language is provided as a part of the controller 
package on all new Mark III Controllers. It is available for all older Mark III 
and Mark II controllers with teach pendants. The ROM in the pendant has to 
be changed to a version 2.3 or later. Versions for the IBM-PC and the Apple 
lle only are supported. It is also possible for sophisticated users to write 
their own languages or routines to control the robot and the work cell. 


In general the motors and the I/O on the robot and the work cell may be 
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controlled in the following ways. 


--> From any general purpose computer by using the kernel commands that 
the controller understands. This allows full control of the Mark II 
controller in machine language. It can give extremely fast and 
sophisticated operation but needs a more sophisticated understanding 
of computers and software to implement. See owner's manual for the 
Rhino XR Series robots. 


--> From any of the languages provided by Rhino Robots Inc., such as 
RoboTalk™ and Rhino-VAL. All of these languages have commands 
that address the "G" and the "H" ports. See the appropriate software 
manual for these commands. 


--> The teach pendant. The teach pendant can provide control either as a 
Stand alone device or within the context of a language. The languages 
provided by Rhino support the use of the teach pendant to define the 
points accessed by the robot. 


ADVANCED USAGE. 


Introduction: A work cell is the normal operating environment of a robot. 
All the machines that serve and are served by the robot are a part of the 
robot's work cell. The workcell is designed as a teaching aid for students 
and trainees. It has all the components of a full sized industrial workcell. 
The software that is controlling the workcell is written in a new robotic 
language called RoboTalk™. RoboTalkisa generic robotic language that is 
similar to all industrial robotic control languages. RoboTalk was developed 
by Rhino Robots Inc. for use as a teaching and training language that is easy 
to use. RoboTalk contains a number of features like an extensive trace 
capability that make it the ideal language for the first time robot user. 
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RoboTalk™ 


RoboTalk is a full fledged robot control language. It is available for use on 
the IBM-PC, the IBM-PCXT and the Apple lle. The language is written in "C" 
and then compiled to run on the target processors. The language cannot be 
modified by the user. RoboTalk supports integer math. RoboTalk has 29 
commands and a full fledged single line editor similar to the Unimation 
VAL™ editor. RoboTalk is the ideal first language for all individuals 
interested in learning about robots and robotic languages. The entire 
system is under the control of an IBM-PC personal computer running a 
RoboTalk program. 


RoboTalk is anew robotic language developed by Rhino Robots Inc for the 
educational and training market. RoboTalk is a generic introduction to all 
robotic languages. 


TRADEMARKS 


Rhino™, and RoboTalk™ are the trademarks of Rhino Robots Inc. 
VAL™ is the trademark of the Unimation Corporation. 

Apple Ile™ and Macintosh™ are trademarks of Apple Computers Inc. 
IBM-PC™ is the trademark of IBM. 
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APPENDICES 


Rhino supports the Apple Ile and the IBM-PC as host computers for the Rhino 
XR Experimental Robot system. The following pages contain hardcopy 
printouts of RoboTalk™ programs for both systems. These programs are 
also provided on the diskettes provided with the workcell. 


The following RoboTalk™ programs are provided for the IBM-PC: 


1.  tstfeed Ball feeder test program 

2.  tstorder Order center test program 

3.  tstinspe Inspection station test program 

4. worki Workcell run program 

3. Wworkdoc Documentation only for the workcell program. 


This program cannot be run. 


The following RoboTalk™ programs are provided for the Apple lle: 


1.  tstfeed Ball feeder test program (program list'g same as 
IBM) 

2.  tstorder Order center test program (program list'g same as 
IBM) 

3.  tstinspect Inspection station test program (program list'g 
same as IBM) 

4. worka Workcell run program 

5. workda Documentation only for the workcell program. 


This program cannot be run. 
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em 
rem file: TSTORDER Order center test routine. 
rem ‘ 

rem Shows any changes to current order on screen. 
rem 7 
outsig -1 

seti a=2 

seti b=t 

7. OUtsigq —1 

outsig 1 

seti s=0 

ifeig -1 then goto 31 

seti t=O 

ifsig -—z2 then goto 32 

ifsig 4 then goto 33 

seti t=t+2 

oo Lfsig 3 then goto 34 

seti t=t+l 

gota 32 

24 seti t=t+2 

32 seti s=1 | 

alo ifs = a then goto 40 

if s + a then goto 40 

if t=b then goto 5 

40 seti b=t 

seti a=s 

cls 

if s=O then goto 50 

type 1008 

type "A new selection has been made." 
type oo oa 

type "The order placed is:" 

type bo $0 

if t=O then type "1 of each" 

if t=! then type "1 dark ball" 

if t=2 then type "2 dark balls" 

if t=>5 then.type “1 light bali" 

if t=4 then type "2 light balls" 


goto 3 

uO type "" 

type "No selection has been made." 

goto & 

end 

rem 

ream 

rem outsig -1 sreset order data latch line 
rem seti a=2 sinitialize copy of selection flag 
rem seti b=t sinitialize copy of type flag 
rem 3S outsig —-1 sreset order data latch line 
rem outsig i ? slatch order center data 

rem seti s=O sinitialize selection flag=no selection 
rem ifsig -1 then goto [731 sOranch if no selection made 
rem Sseti t=O initialize type flag=1 of each 
rem ifsig -2 then goto 32 ;Oranch if type=1 of each 

rem ifsig 4 then goto 33 sOranch if dark ball (s) 

ream seti t=t+2 slight ball so offset t 

ram 33 ifsig 3 then goto 74 sbranch if 2 balls 

rem seti t=ttl ;one ball so offset t 

rem goto 32 | 

rem 24 seti t= 


t+2 
i 


rem 3s seti s sa selection has been made 


rem 
rem 
rem 
rem 
rem 
rem 
rem 
rem 
rem 
rem 
rem 
ream 
rem 
rem 
rem 
rem 
rem 
rem 
rem 
rem 


ream 


rem 


et 


40 


if sta then goto 40 


if stra then goto 40 sbranch if 
if t=b then goto 3 sbranch if 
seti b=t scopy t 
seti a=s scopy s 
cls 

if s=O then goto 5o sbranch if 
type a 08 


type "A new selection has been made." 
type 18 tt 

type "The order placed is:" 

type 16 4 

if t=O then type "1 of each" 


if t=1l then type "1 dark ball" 

if t=2 then type "2 dark balls" 

if t=2 then type "1 light ball" 

if t=4 then type "2 light balls" 
goto 3 

type 10 88 

type "No selection has been made." 
gota & 


end 


$s changes 
$,t didn’t change 


no selection made 


ii 


rem tlie: iSTINSFECT Froaram to test inspection station Optics 
em and carousel paliet detection switches. 
rem 

3 S@ti a={10 


lu Outsia —-=z 
OQUTSIGQ —S 
OutSsida 4 
GUtTS2G 
LtSig S 
S@Tl x= 
QGOUCSIlAG x 
OUTSIGQ Ss 
GQutsig 4 
OuUuTSIC 
Prana & 
Setl 
OUTS1 
itsia 5 
SET1l “=y 


== 
Then 


Qota Su 


ur 


wll 


goto 


i 
| 


goto 


ifsig 3 
SELL x=5 


goto 


C!! 
ri 
+ 
G 
= 


ltsiag goto 


OuUuCSIG -sz 
Qata 


Goto 


Qota “2 


QUCS1Q 


ek 


gate 


Goto 2u) 


then goto io 


"Order 
“Urder 


then 
then 


dark balls” 
Of @ach, reversed" 


tested 
tested 


tvpe 
type 


being 
being 


lt x= then 
then 
then 
then 
then 
then 
then 
then 


nt ote 2 en oe 

++: t: +, +: + 

Se ae St Ren tee ie 

Hou oh uo own 
RS! OR Bick 


fj. 

+: 

wo 
i 


25 Gutsia —z 


GOULSraQ —F 


type 
type 
type 
type 
type 
type 
type 
type 


"Order 
“Order 
"Order 
‘order 
“Order being 
“Order being 
“Order being 


being 
being 
being 
being 


tested 
tested 
tested 
tested 
tested 
tested 
tested 


“Inspection station 


“A pallet must be seated 


correctly on the carousel. " 


Ba 
ll oll coll ORE ood Oe 


is: i 


error” 


light balls” 
Of Gach" 
light ball” 


dark bali. reversed® 


none? 


dark bail! 


Lf light ball. reversed: 


GOutTS1Q 4 
OUTSIGQ —-S 


ifsSig S then goto 35 
Seti a=1u 

gota 3 

end 

ren 


OuUCSI1g 2 


OuCSIG —.s 
aoutsia 4 


GULSia -> 

wyTSIQ S then gota 3u 

rem 

rem 3 Se@tT1l a=1y sinitialize copy or x 
rem iw OUuUTS1IQ —<E scheck if oOallet seated 
rem WUC. GS 

rem Quctsig 4 

rem Outsia —-S 

rem irsiqg 3 then goto Su ;Grancn it pallet not there 
rem Seti “x= ;initialize x 

rem Outsig £ schneck tor «< dark balis 
rem -OUTSIG os 

rem GUtSlaQ + 

rem Outsig s 

rem itSig S then goto zu ;Oranch it «< Gark balis 
em Seti x=] 

rem oOucsiqg —4 

rem it+S1qa 3 then goto Zu sOranch it | ar each. reversed 
rem SetCl H=e 

rem GUTS1IQ ~-S 

rem 1tSi1qQ S then goto £0 sOranch if 2 iiant balls 
rem S@TL H=3 

rem oOucsig +4 

rem ltSIG BS then aorta “vy sorancn itr | ar e@acn 

ream SeETl x=4 

rem OUtTSiaQd —-<« . 

rem l1f#S1ia 3 then goto “£u sobranch ar i light bail 
rem SetlL x=S 

rem GUTSIG S 

rem ifS1iq 3 tnen goto e£u sbrancn it 4d dark ball, reversed 
mr em Setl x=o 

rem GUESlA AS 

rem 1+S1Q S then goto Ln sorancn it none 

rem SeTlL K=/ 

rem OUTSIGQ « 

rem iyS1qQ 3S then goto £0 spranch it 1 dark ball 
rem Setl x= 

rem aoutsiaqa —4 

rem ifSiqQ 3S then goto gu sbranch it 1 iliqgnt bail. reversed 
rem Seti “x=4 | ;no match so error 

rem <0) it a=x then goto 10 sbranch it no cnange since last time 
rem cis 

rem type 7" supdate screen 

rem lt H= tTnNen tyoe ... 

rem it x=i then type ... 

rem lit H=s2 tnen type ... 

rem it N= then type ... 

rem if x=4 tnen type ...- 

rem lit X=S3 then tvpe ... 

rem lif K=6 tnen tvpe ... 

rem lt x=, then tvpe ... 

mem lf X=o then tyoe ... 

rem it x=7 then tvpe ... 

rem S@T1l aA=x sreset coov or x 

rem Gore. i 

rem 2 Cis 


tant ved 


2.8% 


tcvpe 


tvoe “H pallet must be seated correctiv on the carousél. 


eutSsiq =< 

Gurcsiag —s 

Gutsig 4 

OutSia os 

ifsia 5S then goto 5 
seti a=1u 

Goto 's 

ema 


smMake Sure 1 S seated 


bi 


Tis) 
rein 
rem 
rem see WURKUGC. 
rit 
OUTSIQ 
CutSig 
OuUTSIg 
cis 
MOVED soo 
<0 S@Ti m=u 
Cis 

tyoe “: 

type “'riace 
2 OUTSIQ —i 
GUTSIG —,/ 

QUCSIg —y 

GOSuo ww 

if S=vU tmen gota Hs 
SETl m=n+it 

CLs 
type 
type 
TCyYpe 
type 
tvpe 
type 
it t=O then 
it t=1 tnen 
lt t=Z then 
Lf t=3 then 
Qoto £5 

“lo tvpe "1 of each" 
type "FE 

QGOsup 
QJosup 
QOstup 
Gosub 
dosub 
Qosub 
QQaSsuUo 
Gote £0 


FILeGe: WURK, i WOric 


oo 


ae 
at 


4 
wae 


VOUr order 


Ba 
choco 


ot it 


"te 
r 


jéoas 


E@CutIing oraer 


“Urder 


Pots 


BLaced iss 


GCOnpG 21 
goto 22 
Qoto 
goto 


“lo dark bali" 
WOSuo 
Gosub 
Dosuo 
Qasup 
qdasuo 
gato 
“3 type 
type "4 
Gosup 
Qosup 
Qosuo 
9osub 
Qostup 
gosuo 
QOSuUD 
gota 
«+4 type 


al) 


Gark opalis' 


ay. dees 
bos 
Sine 


> i 
wh 


‘L Liant bali" 


Gell proaram tor the ie 


ror documentedq Version, 


ti 
a 


Cycle numoers ! 


Ei 


it o4! 


type 
gosubp 7uU 


gosub 4/7 

gosuo oo) 

gosub 7S 

gosup 71 

goto eu 

=o tyoe “2 Liraht balls” 
tyoe og 3! 

gosuop Fu 

gosuo 46 

qosugo 4/7 

gosub ou 

gosuo 73 

gosub 74 

gosupo vl 

goto “uy 

ow moveo 15 

gosuo 4 

if t=0 then goto ol 
it t=1 then goto o< 
if t=2 then goto os 
if t=3 then goto 64 
goto oo 

ol if x~=3 then goto && 
gosup as 

lf x= then goto 1us 
i¢ x=1 tnen goto les 
if x=s then goto luy 
if x=4 then goto ives 
if x=5 then goto i«4 
i¢ x=6 then goto ize 
if x=/7 then goto 105 
if x= then goto 12% 
gota .u0 


of lt “w=7 
gosubp dad 
if “=u then 
def tnen 
lf x=Ee then 
if x=3 then 


it x=4 then 
if x=3 then 
lft x=6o then 
if x=3 tnen 
goto 2£0u 

Oo lf =u 
qosub dad 

lit x=il then 
if x#=2 tnen 
it x= then 
if “x=4 then 
if x=S then 
if x=6 then 
it xX=y then 
if x=d then 

ame) 


gosup oa 


lf “x=O then 
if x=l then 
it H=E=e tnen 
if x=35 tonen 
lt x=5 then 
Lf Xo tTHen 
it “=; 


then 


goto 
goto 
goto 
goto 
gota 
goto 
gota 
goto 


qoto 
goto 
goto 
goto 
goto 
goto 
gaota 
goto 


qaoto 
goto 
goto 
goto 
goto 
gota 
aqata 


then gota 8Y 


Pod 
£iS 
tet 
Lud 
Lau 
Loe 
16 
Loy 


4» then goto 89 


Lag 
ae a 


: fen | 
ary 
wes afeo 


Lili 
Loe 
es 
Ly 
Oe 


bc) 
Pie 
ieee 
jaeie 
Los 
tos 


Leo 


goto 200 

Ooo lf “=ZE then goto 89 
gosub 8% 

if x=0 then goto 118 
it x=1 then goto 10% 
lt x=3 then goto Li4 
if x=4 then goto 104 
lt x=3 then goto 119 
lt x=5 then gore ii? 

lt “=z then goto i27 

lf x=3 then goto i105 

goto £00 

oy outsig 7 

GOULTSIg -—s ; 

Cype “Urder is ACCEFRTED" 

MOVED soG 

return 

35 outsig 3 

OUcSig —7 

Cype “Order is REJECTED" 

MOVep soo 

return 

200 type "« 

type “Inspection Station maitunctioning. " 
type "Check it ang restart the program. © 
end 

Luo gosup 74 

goto 6) 

lol gosub 75 

gota 6 

{15 gosub 74 

lose gosubd 76 

goto ov) 
llo gosub 
LOS gosuo 7 
Goto ow 

114 gosub 74 
104 gosuo 46 
Goto ov 
L200 gosuo 7 
108 gosuo 7 
105 gosub 4 
gota 6 
lei gosub 7 
uF gosub 7 
Oo gosub 4 
gota 6u 

lie gosub 74 
lil agosub 75 
Lin gosubd 48 
107 gosub 49 
goto 60 

{l3 gosub 74 
goto 110 
11S gosub 7 
L1i9 gosub 7 
li?y gosub 4 
goto ins 
<2 gosub 75 
gota 107 

tee Qosub 75 
Goto ive 

feo gosub 74 
le4 gosub 7o 
Goro ius 


L2zo gosuo /4 


qeto Ls 


l27 gosub 74 
qeto i417 
126 gosub 4a 
goto lus 
ley gosub 7/7 


goto iwe 


4c) Seti “=u 

COUTSIA « 

QOutsig 3 

oucsia 4 

Qutsig &S 

itsig -S then aoto 

tyoe "ARetual order iss « 
return 

1 SetT1l xX=1 

outsiaq —4 

lfS1QgQ -3 then gota «z 
type “Actual order is: | 


renurn 

2 Seti #x#=2 

QUtTSIG —S 

ifsig —S them goto. 


dark balls” 


ot each, reversed” 


type "Actual order iss « light balis” 
return 

oo $eTl X=5 

OutSsig 4 

1fSsiGg -3S tnen goto 

type "Actual order is: 1 ar eacn” 
return 

4 seti x=4 

GOUCSIQ 

ifsiq -S them goto & 

type "Actual oraqer is: 1 iight ball” 
return 

43 S$e@T1L K=5 

Outsig 

ifs$1g —-S then gato 

type ‘Actuai order 1s: 1 dark ball, reversed” 
return 

oOo S$@CTl xo 

Outsigqg 3 

li#Siqg -S then goto 7 

type “Actual order is: none" 

return 

7 Seti x=! 

QUTESIGQ « 

LfS1Q -S tnen goto a 

type "sctual order is: 1 dark ball” 
return 

o seti x=s 

outsigq —-4 

itsiqg -S then goto 9 

type “Actual order iss 1 light bail, reversed” 
return 

7 seti “=7 

return 

oo) Seti s=u 

seti tu 

auctcsia 1 

ifsiaq -—i. then goto si 

ifsig -z then goto sez 


ifsig 4 then goto S33 
seti t=tte 


SS ifsia 3 then goto 34 


wr, 


qote 32 
24 seti t=tt+i 

Se seti s=i 

ol return 

Sz pause 5 

SO ifsig b then goto &i 
AUX A 

Walttor 6b 

goto 2 

Si seti a=-a 

aux a 

return 

47 gosup 7u 

goto 75 

45 gosuo 7 

goto 72 

7 Seti o=-7 

Seti a=l 


type "Checking if enougnm dark 


gosuo ou 
20 type “Getting a dark ball” 
movep spG 

movep ado 

mOovep doa 

MOovep adc 

mOvVeD soc 
return 

4/7 gosub /i 
goto 73 

$6 gosub 71 
qa6to fz 

71 seti b=-38 
Seti a=] 


Cype “Checking if enougn Lteant bails" 


gosup sw 


Sl type ‘Getting a light ball" 


Mavep spo 
movep aio 
mavep ila 

moveo aic 
MOvep soc 
return 


109 wee 


fe type "'Flacing bali on Fight side of 


MOoveoD rac 
mMOovep rec 
MOVED rao 
MOveoD spo 
return 


balls" 


pallet" 


po type "“Flacing ball on left side of palilet'" 


MOvep lac 
movep icc 
MOveDp Lao 
MOovep soo 
return 


‘4 type "Emptying rignt side of paliet” 


MOVeD soG 
MOvep rao 
MOVED rca 
MOVED rac 

30 MOVED soc 
MOVED amc 
movep mc 
MOoven emo 
Movep ama 
movepn soo 


return 
7/3 type "Emptving ieftt side of Dailet" 

moveo sno 

moOvep Lao 

mQOveo ico 

movep iac 

goto 50 

fa type "Transtering ball from left to migmt” 
mOveDp soG 

MOovepD lao 

moaveao lca 

mavep lac 

movep rac 

movep rcc 

MOVED FAG 

movep spo 

return 

// type ‘Transfering bali from rignt to left” 
MOvVeD Spa 

movep rao 

movep rca 

MOVeo rac 

movep Lac 

movep icc 

movep Lac 

MOvep spo 

return 

7U outsig = 

GUCSIG os 

Qutsiaq 4 

BUtTSIQ —-sB 

LtSiGg to. then qete 37 

Seti b=6 

SeCtl a=z 

type “Checking if a pallet is available” 
Qosub su 

~%7 type "Getting a pallet” 

MOvep soag 

Outsig « 

GULSiQg 3 

Qucsig 4 

GUES1¢G. => 

17S1G. -S then qoto 37 

movep apa 

movep po 

mOvep apc 

mOovep soc 

MOvVep acc 

MOVED acl 

mMOVeB cc 

MOVED aca 

mMmOvVeo soo 

QUuTSIQ «< 
QUCTS1Q 3 
GButsiq 4 
GUTSIGQ —-S 

ifelg -a then dota 5/7 

tyvee 

type "Fallet mispiaced--piease heip.” 
type 

Waltror —-S 
Jf PetUurn 
wl type "Returning the pallet” 
MOveD SoG 

MOVED a& 

MOveo cG 


MOVED acc 
movep anc 
moOvep nc 
movep ahoa 
MOovep soo 
return 
ream 

rem point 
ST 

MOvVeD po 
mOvep aoc 
MOVeD apo 
MOVeSB anc 
MOveop ana 
MOvep mc 
MOVEeO rec 
Mmovep rca 
movep rac 
MOVED Frac 
MOvep 1¢co 
mOoveo icc 
MOVED Lac 
MOvVep 1LaG 
MOvVep acl 
MOaveo aca 
MOvep acc 
movep soo 
MOvep soc 
mOvep aoa 
MOveD aac 
MOovep ado 
MOVED 1o3 
movep alo 
MOVeD aic 
moaveop mc 
MOveo amo 
mOveo amc 
nmavep ema 
Movep ca 
MOvep cc 
rem EN 


Gerinitions 


am 
Tile: WHREDUC Workceil program \inon-executaoies. documented version. 


rroaram cgescriotion: 


ine Rhino Workceili simulates a TvyPicai Palletizina and inspectian 
orocess where the items to be palletized are specified bv a 
remote device. in tnis case, if the inspection process 
determines that an order was filied incorrectly, the workceli 
Wiil attempt to correct the order. Also. the Rhino Workcell 
will disassemble am order and repiace all the parts sa that 
lt can repeat the process over and over. 


In general, the palletizing process involves Gbtainina an order 
ror fl or 2 balls of either 1 or 2 colors, placing them ona 
Pallet, inspecting them and returning them to their stations. 


specitically: The workcell will wait for an order to be placed 
at the order center. Once the single cycle or run keys are 
pressed the workcell will determine if all the necessary parts 
including the pallet are available. If they are not, the 
workcell wiil attempt to bring them into place by operating the 
vertical conveyor for needed dark or light bails, or the : 
horizontal conveyor for pallets. Once the parts are available, the 
workcell will obtain a pallet and place it on the rotary carousel 
if a pallet is not already in place. I¢ the pallet does not 
get seated correctly the workcell will_-notify the operator 
Dy printing a message to the screen. Then according to the 
order that was placed, the workcell will get and place the 
needed dark and/or light balls onto the pallet. The filled 
Pallet is then sent to the inspection station where the order 
1S checked to see that it matches the requested order. I+ the 
order 18 correct the accept lamp is turned on and the pallet 
1S Brought back to the robot for disassembly. If the order 
is found to be incorrect, the workcell will attemot to correct it. 
it should be noted that the order, prior to the inspectian 
process can be manualiv modified in order to show the attempts 
to correct a wrong order. However, modifying the order after the 
inspection process will not be recognized by the workcell. 
During the above process, the screen will continually show the 
current status of the operation. The workcell can be operated 
In singie cycle mode where a single order is placed and tilled, 
or aS a run of single cycles where the order is filled over 
and over again. 


2ame special notes... 


MH cycle is composed of bringing output line i low to latch the data 
present at the order center. This line also turns on the green 
LED at the order center to show that cycle is in operation. 
Therefore output line i should not be brought high again until 
the cycle is complete. 


HS a rule, taught points are named with labels ending in ‘c for 
Gripper closed or ‘oo’ for gripper open. In all movego 
commands, the gripper is executed first. Theretore a 
routine sucn as... 
Move HAXHOG 
MOVED KHXC 
Will Save program space DY not requirina an intermediate command 
SUC AS. « 


HIVE NAA 
ciose -| 
MOVED RMNC. 


Ir run continuous mode is Selected, pressing a new order Will 
be accepted. That is, you can change the order Guring a run. 
Holding the single cycle selection down will operate in the 
Same way aS a run cantinuous’ selection. 

For sinale ball or mixed orders, the dark ball is placed on the 
right and/or the light ball is placed on the left side of 
the pallet. 

Mine amspection station will not operate correctly if a pallet is 
nat seated properly on tne two Pins on the platter of the 
rotary carousel that has the switches On @1tnhner side of the 
Dins. However, in normal operation. the workcell checks tor 
this and notifies the operator of any malfunction. Since the 
inspection station is normaliy anly active when an order is 
being inspected and a pallet is in place, this presents no 
problem. 


ferore running this program the user must be sure all connections 
nave been made according to the workcell wiring diagram, that 
che aux Ll and aux 2 switches are in the down POSition and that 
the ball sorter mechanism s POwer supply is turned on. The 
user should check the ball sorter mechanism by dropping a few 
Giftterent colored balls into the chute at the very top of the 
Vertical convevor. If a Bucket is in the Ways YOU Can move it 
either bv manually turning the knurled knob on the vertical 
convevor s motor or under Robotalk control Using the direct 
execution made and the aux commands. The user must also be 
sure the carousel and slide base are at their respective 
initial (home) positions. The operator can do this via the 
teach pendant system before running Robotalk. Refer to the 
start-up procedure sheet. The robot arm itself can be homed 
Dy answering yes when Robotalk asks if the robot is to be 
initialized. Unce the robot has been homed, the operator 
should make sure the hand is staright up and down by manually 
moving it. Do not use the pendant to accomplish this. The 
program can be run by loading WORKI for the IBM FC or 
WOREA ror the Apple Ile and Pressing R tollowed by return. 


rort definitions: 


inputs Outputs 

i Urder center data 1 Order center data latch 
< Order center data « Inspection station data 
~ Urder center data = Inspection station data 
4 Order center data 4 Inspection station data 
~ Inspection station data ~ Inspection station data 
6 Fallet detect 6 No connection 

/ Dark ball detect * Accept lamp 

S Light ball detect 3 Reject lamo 


Input S is also used to detect if a pallet is seated properly 
On the rotary carousel. 


Forts A-F:s Standard xR-2 confiquration. 


Fart G: Linear slide base. 

Fort Hs Rotary carousel. 

Aux 4d sVYertical convevor iswitch down). 
FLU sHorizontal conveyor ‘switch down). 


Continued to WOREDOCI... 
rem 


We AT As LEN goto sy 7Oranch 1f Correct 
gosub 88 reject Lamp on 
if “=O then goto idl 79G0t 2 dark balls 


lt x=l then goto 115 s:aqot 1 of each reversed 

lf x=2 then goto i121 ;Got 2 light balls 

if x=a then goto ioi 7GG6t 1 of each 

it x=4 then goto 125 s:qot i light bali 

it x=5 then goto 1o2 °GOot i dark ball reversed 

lf x=6 then goto 106 ;Got none 

if x=8 then goto 109 sqot i light ball reversed 
GOtq 200 7error-bad inspection station 


rem Check &/or correct for 2 Gark balls. 


O35 if x=0 then goto 89 -Oranch if correct 
Gosub 88 sreject lamp on 
it x=l then goto 105 +sgot i of each reversed 


1 
it M=2 then goto 112° sqet 2 lignt balls 
lt X=3 then goto 122 sqot 1 of each 

f= Chem goto i1dt. saet. 1 light ball 

3 then goto 106 sgot i dark bali reversed 
lt x=6 then goto 110 sgot none 

7 then goto 107 saqot i dark ball 

So them goto i113 eqot i light ball reversed 
Gato 2Oo ;error-pad inspection station 


rem Check &/or correct for i light ball 


64 if x=4 then goto 89 sOranch if correct 
gosub 6&8 sreject lamp on a 
lf x=O then goto 120 srgot = dark balis 
it x=1 then goto 116 °got 1 of each reversed 
lt x=z2 then goto 100 :egot 2 light balls 
it x=4 then goto 100 sqot 1 of each 
if x=S then goto 108 sgot i dark ball reversed 
lt %=6 then goto i105 s:aot none 
it x=7 then goto 126 sgqo0t 1 dark ball 
it Hes then gota 1035 sqet 4 light ball reversed 
gota 2oG ;error-bad inspection station 


rem Check &/or correct for 2 light balls 


55 if x=2 then goto 89 ;Oranch if correct 
gosubp 8& sreject lamp on 
if x=O then goto 118 sqot 2 dark balls 


if x=i then goto 108 sgot 1 of each reversed 

if x=3 then goto 114 sqot 1 of each 

it x=4 then goto 104 sqot 1 light ball 

if x=S then goto 119 sgot 1 dark ball reversed 

if x=6 then goto i117 sqot none 

if x=7 then goto 127 sqot i dark ball 

bt x=S then goto 105 . got 4 light ball reversed 
goto 200 ;error-bad inspection station 


rem Accept/Reject lamo controls 


B7 Outsig 7 sturn on acceot lamp 
outsig -& turn off reject lamp 
type "Order is ACCEPTED" 
movep sDO bring order back to robot for removal 


return 
38 outsia & eturn on reject tamo 
GUtSIQ —7 sturn. off accept lLamo 


tvpe "“Urder is REJECTED" 
movep sbdoO :bring order back to robot for removal 
return 


rem error-bad inspection Station: Start over. 


2020 type "" 
type "Inspection station Maltunctioning. " 
type "Check it and restart tne program. " 
end 


rem Continued to WORE DOC2 


rem 
Tem 
rem 
rem 
At 


4) 


en no selection was made. [+ Sei then a 


Selection was made & t contains the type of selection. 


Un return, if s=0 th 
t=O, 1 of each. t=i 
t=3, 1 light ball. 

seti s=) 
seti t=0 


ouctsig il | 

itsig ~-i then goto [Fi 
ifsigqg -2 then Goto 32 
ifsiq 4 then goto 33 
Seti t=t+2 

ifsig 3 then aoto 34 
seti t=t+l 

goto 32 

S@ti t=t+2 

seti s=i] 

return 


* 1 dark ball. t=2, 2 dark balis. 
t=4, 2 light balls. 


;s@lect tlag=no selection made 
type tlag=1 of each 

slatch data 3 
sbranch if no selection made 
;branch if 1 of each 

sDbranch if dark ball 

slight ball so offset t 
sOranch if 2 balis 

steel (1 dark), 623 (1 light) 


pte (2 dark), t=4 (2 light) 
;select tlag=selection made 


rem Vertical/Horizontal conveyor operation. 


rem Caller sets output line b. b=7, dark ball detect. b=8, light 


rem 
rem 
rem 
rem 
rem 
rem 
rem 
rem 
rem 
rem 


= 
BC) 


ball detect. b=6, 5 


allet detect. 


Caller sets aux a. a=i., vertical conveyor. a=é, horizontal. 


I¢t caller needs dark 
I¢ caller needs ligh 
I+ caller needs a pa 
When called, if item 
1s turned on until 
1s used after detec 
talse Signal. Conv 
Line 80 is the entry 


pause §& 

1*+S1ig b then goto Si 
AUX A 

Wwaittor b 

goto 82 

Seti a=—-a 

ALIX aA 

return 


balis, caller should set b=-7, a=i. 

t balis, caller should set b=-3, axl. 
llet, caller should set b=6, a=2. 

not present, the appropriate convevor 
item detected by optics. «A short delay 
tion to ensure bounce doesn’t give a 
eyor 1s then turned off. 

pont. 


;debdounce 

sreturn if item detected 
sturn on appropriate conveyor 
;Walt tor item to be detected 
sdelay then check aqain 
;change sign 

turn orf conveyor 


rem Hail handling routines. Get, place, emoty, transfer. 


rem 


$y 


rem 


4c 


rem 


Fi) 


ace on lert side. 


bet a dark ball & pl 
qosub 7/0 
goto 73 

Get a dark ball & place on right side. 
gosup 7 

qote 7/2 

set a dark ball 

seti b=-7 sdark ball detect line 
Sseti a=l svertical conveyor 

type "Checking if enough dark balls” 
gosubp 8 Fensure enough dark balls 
type "Getting a dark ball" 

movep sno ;Sate position, open 
movep ado sabove dark ball, open 
movep doa sat dark ball, open 

MOveo adc sabove dark ball, closed 


moveop sbc Sate position. closed 


return 
rem Get a liqht ball & place on left 


47 gosub 71 
qoto 73 


rem Get a light ball & place on right 


46 gosub 71 
goto 72 


rem Get a light ball 


7l seti b=-3 slight ball detect line 


seti a=i svertical convevor 

type "Checking if enough light balis” 

gosub 8 Feansure enocugn Light balls 
vl type "Getting a light bail" 

movep sbo ;Sate position, open 

mavep alo sabove light ball. open 

mavep lo sat light ball. open 

movep alc sabove light ball, closed 

movep soc ;Sate position, closed 

return 


rem Flace ball on right. 


72 type "Flacing ball on right side of pallet" 


moveo rac ;above right side, closed 
movep rcc sat right side, closed 
movep rao sabove right side, open 
movep sbo ssate position, open 
return 


rem Flace oall on left. 


72 type "Flacing ball on right side of pallet" 


mavep lac ;eabove left side. closed 
moaveop icc sat left side, closed 
mavep lao sabove left side, open 
maveop sboa ssate position. open 
return 


rem Emoty right side of pallet. 


74 type "Empyting right side of pallet" 


mavep sbo ;Ssafe position, open 
mOovep rao sabove right side, scpen 
mavep rco sat right side, open 
movep rac sabove right side, closed 

26 movep sbc sat sate position, closed 
movep amc ;above ball return ramp, closed 
moveo mc s;at ball return ramp, closed 
movep emo ;at empty position (putt), open 
MOvVeOD amo sadove ball return ramp, open 
mavep sbo ssate position, open 
return 


rem Empty left side of pallet. 


fo type “Emptying left side of pallet” 


moveo sbo ssate position, open 
movep lao sabove lett side, cpen 
maveo ico sat left side, open 


movep tlac sabove left side. closed 


See ee Q ted Ld Lilie fr est OF ae 
rem Transter ball left to right 


76 type “Transfering ball from fete to right” 


movep sboa 7Sate position, open 
mavep lac ;above left side, open 
movep ico sat lert side, open 


- 
mOveo lac sabove lett side, closed 
MOvep rac sabove right side, closed 
mMOoveo rec sat right side, closed 
mOovep rao 7above right side, open 
mOovep sbo Sate position, open 
return 


rem Transter ball right. to -ket¢t, 


//7 type “Transfering ball from might to left" 
mOovep sbo sSate oosition, open 
MOveoO rao above right side, open 
moveop reco at right side, open 
mOovep rac above right side, closed 
movep lac above left side, closed 
movep icc at left side, closed 
movep lao above left side, open 
movep sbo Sate position, apen 
return 


‘258 38 25 25 28 sa 


rem Continued to WOREKDOC= 


TRE 
tliies 


rem Get a 


IU) OuTSia 


WORE DOCS 


Da 


lliet & olace on carousel 


Continued from WORKDOC2 


scheck it pallet alreadv on carousel 


z 
OUutTS1qQ 3 
Outsig 4 
outsiaq -S 
ifsSiqg -S then goto S37 sbranch if alreadv there 
seti b=6 sDallet detect line 
Setl a=z shorizontal conveyor 
type "Checking it a pallet 1s avaiiable' 
gosubd 80 sensure Rave enough pallets 
27 tvoe "Getting a pallet" 


movep sbpo 


Sate position, open 


Qutesigqg « ;check it pallet already on carousel 
outsiq 3 

outsig 4 

outsia -5 

ifsiq -3S then goto 37 sbranch if already there 

movep apo sabove pallet teed, oven 


: 
movep po sat pailet feed. open 

movep apc sabove pallet feed. closed 

movep soc sSafe position, closed 

mOovep acc sabove center carousel, closed 
MOVED aci sjJuUSt above center carousel, closed 


mavep cc ;at center carousel, closed 

movep aco sabpove center carousel, open 
movep sbo ;Sare position, apen 

Butsig 2 scheck it pallet seated correctly 
Outsig 

outsig 4 


Outsig —-S 

itsig -S then goto S37 sbranch if seated oroperly 
type mor 

tvpe "Fallet misplace--please help.” 

tvpe "" 


Walt for —-S 
o/ return 


rem Return pallet to pallet return ramo. 


91 tyoe "Returning the pallet 
movep sdo sSate position, open 
movep aca sabove center carousel, open 
moveo ca sat center carousel, open 
mMOVeBD acc sabove center carousel, closed 
mavep anc sadove pallet return ramp, closed 
movep hc sat pallet return ramp, closed 
MOvep ano sabove pallet return ramp, open 
mMOVvVeD sdo ;Sate 90sit10Nn, open 
return 


rem Foint derinitions. 


mMOveD rac sabdove right side of pallet at carousel, closed 
moveop rao sabove right side of pallet at carousel, open 
MOvep rcc Fat right side of pallet at carousel, closed 
mOovep rca fat right side ot sallet at carousel, open 
moved lac sabove left side of pallet at carousel. closed 


MOvep 
movep 
MOvep 
MOVvVeD 
Movep 
MOVeD 
MOoOvep 
mMmOoOvep 
Moves 
Move 
MOovep 
Movep 
movep 
mMmOoOvep 
MOVEDpB 
MOoOVeDp 
MOVep 
MOvep 
MOAVep 
MOoOvVvepo 
MoOvep 
mOvep 
MOVED 
nNMOoOveps 
MoOvep 
MOvep 


Lao 
bec 
ico 
alc 
alo 
lo 

adc 
AGG 
do 

Soc 
sboa 
AMC 
AMO 
mc 

emo 
Acc 
aco 
acl 
cE 

co 

apc 


apo 


po 
anc 
ano 
ne 


rem END 


] 
9 


above lett side of pallet at carousel, open 


sat lett side of pallet at carousel, closed 


BE -aB Sa 28 2a 2a Bo 8a 48 265 B28 S38 Ba 238 828 2a B28 48 8a #28 


a 


at lett side of pallet at carousei, open 
above light ball feed ramp, closed 

above light ball feed ramp, open 

at light ball feed ramp, open 

above dark ball feed ramp, closed 

above dark ball feed ramp, ocen 

at dark ball feed ramp, open 

Sate position, closed (above ail equipment) 
Sate position, open (above ali equioment) 
above ball return ramp, closed 

above ball return ramp, open 

at Dall return ramp, closed 

at ball return rampo, open (putting move) 
above center of pallet at carousel, closed 
above center of pallet at carousel, apen 
just above center of pallet at Carousel, closed 
at center of pallet at carousel, closed 

at center of pallet at carousel, open 
above pallet teed, closed 

above pallet feed, open 

at pallet teed, capen 

above pallet return ramo. closed 

above pallet return ramo. open 

at pallet return ramo, ciosed 


EM 

REM FILE: WOREA AFFLE ITe EXECUTABLE WORKCELL FROGRAM 
REM 

OUTSIG -1 

OUTSIG 1 

2a CLS 

TYFE "“FLACE ORDER" 

20 OUTSIG ~-1l 

OUTSIG ~-7 

OHUTSIG -&s 

OUTSIG 
OUTSIG 
QUTSIG 
IFSIG ~-1i THEN GOTO 26 

IFSIG THEN GOTO 33 

IFSIG 4 THEN GOTO 32 

TYFE "ORDER IS 2 LIGHT BALLS" 
GOSUB 930 —* 

GOSUB 71 

GOSUB 72 

GOSUB 71 

GOSUB 73 

QUTSIG -4 

OUTSIiG -5 

GOTO 20 

oe TYPE "ORDER IS 2 DARE BALLS" 
GOSUB 90 

GOSUB 790 

GOSUB 72 

SGOSUB  7O 

GOSUB 73 

OQOUTSIG 4 

QOUTSIG 5 

GOTO 20 

ao TYFE "ORDER IS 1 OF EACH" 
GOSUB 90 

GOSUB 70 

SOSUB 72 

GOSUB 71 

GOSUB 73 

OUTSIG 4 

WTSI e -—S 

20 GOSUB 95 

GOSUB 75 

TYFE “RETURN PALLET" 

MOVEF SBO 

MOVEF ACO 

MOVEP CO 

MOVEF ACC 

MOVEF AHC 

MOVEP HC 

MOVEP AHO 

MOVEF SBO 

GOTO 2o 

95 TYFE "CHECKING THE ORDER" 
MOVEF IS 

IFSIG 3S THEN GOTO 96 

OCUTSIG 7 

OUTSIG -8 

TYPE “REJECTED” 

RETURN 


Pj e by pj oe 


96 QUTSIG -7 
OUTSIG 8 

TYPE "ACCEPTED" 

RETURN | 

75 TYPE “EMPTY LEFT SIDE" 
MOVEP SEBO 

MOVEF LAO 

MOVEF LCo 

MOVEF LAC 

GOSUR 54 

TYFE “EMPTY RIGHT SIDE" 
MOVEF SBO 

MOVEF RAO 

MOVEF RCO 

MOVEF RAC 

56 MOVEF SEC 

MOVEF AMC 

MOVEF MC 

MOVEF EMO 

MOVEF AMO 

MOVEF SEO 

RETURN 

90 SETI B=é 

SETI A=? 

TYFE "CHECK FOR FALLET" 
GOSUB 8a 

TYFE "GET FALLET" 

MOVEP SEO 

MOVEF APO 

MOVEF FO 

MOVEF APC 

MOVEF SEC 

MOVEF ACC 

MOVEF ACI 

MOVEF CC 

MOVEF Aco 

MOVEF SEO 

RETURN 

70 SETI B=-7 

SETI A=1 

TYFE "CHECK FOR DARK BALL" 
GOSUB so 

TYFE "GET DARE BALL" 
MOVEF SEBO 

MOVEF ADO 

MOVEF DO 

MOVEF ADC 

MOVEP SBC 

RETURN 

71 SETI B=-98 

SETI A=1 

TYFE “CHECK FOR LIGHT BALL" 
GOSUB 80 

TYPE "GET LIGHT BALL" 
MOVEP SBO 

MOVEF ALO 

MOVEF LO 

MOVEF ALC 

MOVEP SBC 

RE TURN 

72 TYPE "PLACE ON RIGHT" 
MOVEP RAC 

MOVEF RCC 

MOVEP RAO 

MOVEF SEO 

RETURN 


fo LYS “RPLALE. UN LeErFi” 
MOVEP LAC 

MOVEF LCC 

MOVEP LAO 

MOVEFP SBO 

RETURN 

82 FAUSE 5 

80 IFSIG H THEN GOTO 8i 
AUX A 

WAITFOR B&B 

GOTO 82 

981 SETI A=-A 

AUX A 

RETURN 


EM 

REM FILE: WORKDA AFFPLE Ile WORKCELL FROGRAM, DOCUMENTED VERSION. 
REM 

REM WOREA IS THE EXECUTABLE FROGRAM. 

REM : : 

REM REFER TO ‘WOREDOC’ FOR A MORE COMPLETE DESCRIPTION OF THE 

REM OFERATION OF THE WORKECELL. 


REM 
OUTSIiG —1 ; INITIALIZE ORDER CENTER (CLEAR DATA) 
GCUTSIG 1 

zo CLS | 
TYPE “PLACE ORDER" 

=O OUTSIG ~1 sRESET LATCH LINE 
OUTStG: -7 s TURN OFF ACCEPT LAMF 
UUTSIG —s ;s TURN OFF REJECT LAMP 
QUTSIG 1 sLATCH ORDER CENTER DATA 
QUTSIG 23 ;SET UF PARTIAL DATA AT INSFECT STATION 
OUTSIG 3 
IFSIG. 1. THEN -<GOTO: 24 s BRANCH IF NO ORDER FLACED 
LPSlG -2 THEN GOTO 33 > BRANCH IF 1 OF EACH 
IFSIG 4 THEN GOTO 32 3 s BRANCH IF 3 DARE BALLS 

REM 
TYFE "ORDER IS 2 LIGHT BALLS" 
GOSUB 90 ;GET A FALLET 
GOSUB 71 ;GET A LIGHT BALL 
GOSUB 72 sFLACE ON RIGHT SIDE OF FALLET 
GOSUB 71 , GET A LIGHT BALL 
GOSUB 73 sPLACE ON LEFT SIDE OF FALLET 
OUTSIG —4 ;SET UF REST OF INSFECTION STATION DATA 
OUTSIG -S 
GOTO 30 ;DO THE REST OF IT 

REM 

=2 TYPE “ORDER IS 2 DARK BALLS"” 
GOSUB 90 sGET A PALLET 
GOSUB 70 © ;GET A DARE BALL 
GOSUR 72 sFLACE ON RIGHT SIDE OF FALLET 
GOSUB 70 ;GET A DARKE BALL 
GOSUB 73 sFLACE ON LEFT SIDE OF FALLET 
OUTSIG 4 sSET UF REST OF INSPECTION STATION DATA 
OUTSIG &S ; 
GOTO 30 3;D0 THE REST OF IT 

REM 

2 TYPE “ORDER IS 1 GF EACH" 
GOSUB 90 ;GET A PALLET 
GOSUB 70 ;GET A DARE BALL 
GOSUS 72 sFLACE ON RIGHT SIDE OF FALLET 
GOSHUR 71 ;GET A LIGHT BALL 
GOSUB 73 sFLACE ON LEFT SIDE OF FALLET 
OUTSIG 4 sSET UF REST OF INSPECTION STATION DATA 
C$UTSIG -S : 

REM 

20 GOSUB 95 ; INSPECT THE ORDER 
GOSUB 75 sEMPTY THE FALLET 
TYPE “RETURN THE FALLET" 
MOVEP SBO ;SAFE POSITION 
MOVEF ACO ;sABOVE CENTER CAROUSEL 
MOVEF COQ sAT CENTER CAROUSEL 
MOVEF ACC sABOVE CENTER CAROUSEL 
MOVEF AHC sABOVE FALLET RETURN RAMF 
MOVEF HC ;AT FALLET RETURN RAMF 


MOVEF AHO Ehe sABOVE FALLET RETURN RAMF 


GOTO 20 ;START ALL OVER 
REM 
REM INSPECT THE ORDER 
75 TYFE "CHECKING THE ORDER" 


MOVEF IS ;BRING FALLET TO INSFECTION STATION 
IFSIG S THEN GOTO 96 ;BRANCH IF ORDER IS CORRECT 
OUTSIG -7 ; TURN OFF ACCEFT LAMF 
OUTSIG 8 ; TURN ON REJECT LAMP 
TYPE “REJECTED 
RETURN 
96 OUTSIG 7 s TURN ON ACCEFT LAMP 
SUT SIG 8 : > TURN OFF REJECT LAMP 
TYPE" ACCEPTED" 
RETURN 


REM | 
REM EMPTY. THE FALLET 
73 TYPE "EMPTY LEFT SIDE" 


MOVEF SEO sSAFE FOSITION 
MOVEP LAO sABOVE LEFT SIDE 
MOVEF LCO sAT LEFT SIDE 
MOVEF LAC s;ABOVE LEFT SIDE 
GOSUB 36 sGIVE BALL TO BALL RETURN RAaMF 
TYFE "EMPTY RIGHT SIDE" 
MOVEF SBO ;SAFE FOSITION 
MOVEP RAO sABOVE RIGHT SIDE 
MOVEF RCO sAT RIGHT SIDE 
MOVEF RAC sABOVE RIGHT SIDE 

REM | 

REM GIVE BALL TO BALL RETURN RAMP 

~6& MOVEF SBC ;SAFE FOSITION 
MOVEF AMC sABOVE BALL RETURN RAMF 
MOVEP MC sAT BALL RETURN RAMF 
MOVEF EMO sFUSH BALL DOWN RAMF 
MOVEF AMO sABOVE BALL RETURN RAMP 
MOVEF SEBO ;SAFE FOSITION 
RETURN 

REM 

REM GET A FALLET 

70 SETI B=6 — sPALLET INPUT LINE 
SETI A=2 sHORIZONTAL CONVEYOR 
TYFE "CHECK FOR PALLET" 
GOSUB 80O sENSURE FALLET IN FLACE 
TYFE "GET FALLET" 
MOVEF SEBO ;SAFE FOSITION 
MOVEF AFO sABOVE FALLET FEED 
MOVEF FO ;AT PALLET FEED 
MOVEP APC sABOVE PALLET FEED 
MOVEF SBC ;9AFE FOSITION 
MOVEP ACC sABOVE CENTER CAROUSEL 
MOVEP ACI sCLOSER YET 
MOVEF CC s;AT CENTER CAROUSEL 
MOVEF ACO sABOVE CENTER CAROUSEL 
MOVEF SBO SAFE POSITION 
RETURN ; 

REM 

REM GET A DARK BALL 

7Q SETI B=-7 sDARE BALL INFUT LINE 
SETI A=1 ;VERTICAL CONVEYOR 
TYFE "CHECK FOR DARK BALL" 
bOSUB 80 sENSURE ENOUGH DARK BALLS 
TYFE "GET DARK BALL" 
MOVEP SEO ;SAFE FOSITION 
MOVEF ADO ;ABOVE DARK BALL FEED 
MOVEF DO ;AT DARE BALL FEED 


MOVEFP ADC sABOVE DARE BALL FEED 


ELS VW bend ww LI Ly 


RETURN 


REM 


REM GET 


ZA 


REM 


SETI H=-§ 
SETI A=1 


A LIGHT BALL 


TYFE "CHECK FOR LIGHT RALL" 


GOSUB 80 

MOVEP SEO 
MOVEF ALO 
MOVER LO 

MOVEF ALC 
MOVEF SBC 
RETURN 


sSAFE FOSITION 


sLIGHT BALL INPUT LINE 
> VERTICAL CONVEYOR 


sENSURE ENOUGH LIGHT BALLS 
sSAFE FOSITION 

sABOVE LIGHT BALL FEED 

sAT LIGHT BALL FEED 

sABOVE LIGHT BALL FEED 
sSAFE FOSITION 


REM FLACE BALL ON RIGHT SIDE OF FALLET 
TYFE "PLACE ON RIGHT" 


7a 


REM 


MOVEF RAC 
MOVEF RCC 
MOVEF RAO 
MOVEP SBO 
RETURN 


;ABOVE RIGHT SIDE 
;AT RIGHT SIDE 
sABOVE RIGHT SIDE 
;SAFE POSITION 


REM FLACE BALL ON LEFT SIDE oF FALLET 
TYPE "PLACE ON LEFT" 


Ties 


REM 
REM 
REM 
REM 
REM 
82 


MOVEFP LAC 
MOVEP LCC 
MOVEF LAO 
MOVEF SBO 
RETURN 


sABOVE LEFT SIDE 
sAT LEFT SIDE 
sABOVE LEFT SIDE 
;SAFE POSITION 


ENSURES ENOUGH ITEMS ARE AVAILABLE 
B=INFUT LINE TO CHECK 
A=CONVEYOR TO CONTROL 


LINE 80 
PAUSE & 


[IS THE ENTRY POINT 


SQ IFSIG & THEN GOTO 81 


81 


REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 


AUX A 
WAITFOR B 
GOTO 82 
SETI A=-A 
AUX A 
RETURN 


FOINT DEFINITIONS 


;DELAY TO DEBOUNCE ITEM 
»ITEM IS PRESENT 

; TURN ON CONVEYOR A 

;WAIT FOR ITEM 

;DEBOUNCE IT AND MAKE SURE IT’S THERE 
s CHANGE SIGN 

;TURN OFF CONVEYOR A 


FOINTS ENDING WITH ‘QO’ MEAN THE GRIPPER IS OFEN 
FOINTS ENDING WITH ‘C’ MEAN THE GRIPPER IS CLOSED 


SBO SAFE FOSITION 


OBC 


ACO ABOVE FALLET FOSITION AT CAROUSEL 


ACC 


CO AT FALLET FOSITION AT CAROUSEL 


Cc 


ACI BETWEEN ACO AND CO 


AHC ABOVE PALLET RETURN RAMP 


AHO 


HC AT FALLET RETURN RAMF 
LCO AT LEFT SIDE OF PALLET AT CAROUSEL 


ey Sy 


LAG ABOVE LEFT SIDE OF PALLET AT CAROUSEL 


LAC 


RCO AT RIGHT SIDE OF FALLET AT CAROUSEL 


RCC 


RAQ ABOVE RIGHT SIDE OF FALLET AT CAROUSEL 


REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
REM 
KEM 
REM 
REM 
REM 
REM 
REM 
END 


ABOVE BALL RETURN RAMP 

AT BALL RETURN RAMP 

AT BALL RETURN RAMP, PUSH FOSITION 

ABOVE FALLET FEED AT HORIZONTAL CONVEYOR 


AT FALLET FEED AT HORIZONTAL CONVEYOR 
ABOVE DARK BALL FEED 


AT DARE BALL FEED 
ABOVE LIGHT HALL FEED 


AT LIGHT RALL FEED 


PARTS LISTS 


FIGURE 2: WORK CELL POWER SUPPLY 


FIGURE PART NUMBER PART DESCRIPTION QUANTITY 
99 15-1-99 10-32 x 3/8 SHCS 2 
13 15-1-103 1/4-20 x 3/4 SHCS 4 
109 15-2-109 6-32 x 1/4 BHCS | 4 
129 15-7-127 8-32 x 3/8 Chrome Phillips 2 
794 30-149-794 Corcom Power Module 1 
1025 30-252-1025 Fuse 3AG 1 amp SB 1 
1143 30-120-1143 Power Supply 12VDC 1 
1225 99-131-1225 _ WC Color sorter PCB assy 1 
1250 15-2-1250 10-32 x 3/8 BHCS 4 
1290 950-306-1290 PS housing 1 
1291 950-306-1291 PS base 1 
1292 990-306-1292 PS block 2 
1293 950-306-1293 PS Spacer 1 
1294 950-306-1294 PS Cover 1 
1352 15-2-1352 10-32 x 1/2 BHCS 2 


PERT) CAL COWVEYOR 


PILGURE 


POWER SUPPLY 


2 


FIGURE 


PARTS LISTS 


FIGURE 3: BALL TRACK ASSEMBLY 


Solenoid 3.5 x 9 


FIGURE PART NUMBER PART DESCRIPTION QUANTITY 
97 15-1-97 6-32 x 3/8 SHCS 20 
100 15-1-100 10-32 x 1/2 SHCS 8 
109 15-2-109 6-32 x 1/4 BHCS 6 
363 15-2-363 6-32 x 1/2 BHCS 12 
1208 99-999-1208 Optics module Level Detector 1 
1209 99-999-1209 Optics module Transmitter 3 
1210 99-999-1210 Optics module Receiver 3 
1296 550-306-1296 Upper ball track 1 
1297 50-306-1297 Lower ball track 1 
1298 950-306-1298 Ball track stop block 1 
1299 50-306-1299 Optics module plate 1 1 
1300 590-306-1300 Optics module plate 2 1 
1301 50-306-1301 Ball track side plate 2° 
1302 50-306-1302 Ball track guide 2. 
1323 50-306-1303 Trap door pivoi shaft 2 
1304 50-306-1304 Trap door right 1 i 
1305 50-306-1305 Trap door left 1° 
1306 50-306-1306 Door front support 1 
1307 50-306-1307 Trap door link 2 
1308 590-306-1308 Door rear support 1 
1309 50-306-1309 4 x 12 Solenoid bracket 2 
1310 50-306-1310 3.5 x 9 Solenoid bracket 1 
1311 500-306-1311 . Trap door stop plate q> 
1312 90-306-1312 Ball sorter cover 1 
130 50-306-1353 Solenoid 4 x 12 2 
1354 50-306-1354 1 


CYFLER 4 LOWER GALL TRACK 
FI 


URE 3 


PARTS LISTS 


FIGURE 4: PALLET RETURN RAMP 


FIGURE PART NUMBER PART DESCRIPTION | QUANTITY 
136 15-23-136 | #6 Nylon washer thin 88 
1142 15-27-1142 10-32 hex nut i 2 
1250 15-02-1250 © 10-32 x 3/8 BHES 2 
1320 50-306-1328 Roller track 1 1 
1329 .. 90-306-1329 Roller wheel 44 
1330 ~50-306-1330 Roller track 2 2 
1332 —50-306-1332 Support #1 | 

1383 -50-306-1333 " Base #1 1 
1334 — §0-306-1334 Support #2 1 
1335 50-306-1335 _ Base #1 1 
1336 50-306-1336 Roller track bracket | 
1337 50-306-1337 side Plate 2 
1359 15-70-1335 0.125 x 0.500 Dowel Pin 44 


/NSFECTION STATION 


FIGURE 5 
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PARTS LISTS 


+ FIGURE 6: BALL RETURN CHUTE 


PART NUMBER 


~ 15-1-100 > 


15-12103 


ve 54-10 


15-2-112: 
15-27-145. 


50-305-1313~..” 
530-305-1314 


50-305-1315 
590-305-1316 


50-305-1317 ~ 
50-305-1318 ~ 
50:305-1319 ~ 
50-305-1320 — 
50-305-1321 _ 
50-305-1322 | 
50-305-1323° 
50-305-1324 ~ 


15-2-1352 


15-2-1355: =... 


15-7-1369 
900-306-1383 


PART DESCRIPTION 


10-32 x 4p SHCS: 
~1/4-20 x 1/2 SHCS : 
1/4-20 x 3/4 SHCS — 
6-32 x 3/8 BHCS » 
6-32x5/8BHCS 
6-32 hex futs 


Ball return chute 


Hopper base side A- - 
_ Hopper base side. B 
Hopper ball plate 
Hopper spacer | 
Return. tever‘block 
Returnlever °° 

» Return lever wire 

” Weight sleeve 

_, Ball return track 
“Wire guide. 


* Ball return chute block 


10-32 x +/2 BHCS | 

10-32 x.1/4 BHCS’ 

10-24 x:3/8 ‘Shoulder screw 
ihe cscs _: Figis/ ‘a 
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